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ABSTRACT 


This paper develops a method for modeling terrain 
surfaces for use on Rensselaer Polytechnic Institute's un- 
manned Martian roving vehicle. The modeling procedure 
employs a two-step process which- uses gradient as well as 
height data in order to improve the accuracy of the model's 
gradient. Least square approximation is used in order, to 
stochastically determine the parameters which describe the 
modeled surface. A complete error analysis of the modeling 
procedure is included which determines the effect of instru- 
mental measurement errors on the model's accuracy. Computer 
simulation is used as a means of testing the entire modeling 
process which includes the acquisition of data points, the 
two-step modeling process and the error analysis. Finally, 
to illustrate the procedure, a numerical example is included. 
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PART 1 


INTRODUCTION 


An autonomous navigation system is necessary to 
allow the Martian rover to safely traverse the unknown 
Martian surface. A forty-minute time lag in communication 
between Earth and Mars makes remote control impractical. 

One of the tosks involved is the development of 
a mathematical model to represent the surface terrain in 
front of the vehicle. This model is for use in the vehicle's 
path selection system which will decide whether the terrain 
is passable or impassable. It will then choose the appro- 
priate course of action. 

The vehicle has a laser rangefinder which gives 
all of the data used in modeling. In the proposed system, 
the laser would scan a specified area in front of the vehicle. 
This area is then divided into a number of sections and the 
terrain modeled independently in each one of those sections. 
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PART 2 


DATA ACQUISITION 

Surface information used in modeling is obtained by 
a laser rangefinder attached to a mast extending from the 
vehicle. The mast was assumed to be 3.0 meters high. The 
vehicle and its coordinate system are shown in Figure 1. Here 
the h , a , b —coordinate system is attached to the vehicle 
with the h M axis along the mast and the b M axis in the forward 
direction of motion. The h , a , b— coordinate system is formed by 
the local vertical and an axis in a plane containing the head- 
ing and the local vertical. The two systems are coincident 
at the origin, and are related by the pitch angle f and roll 
angle <}) . 

The laser beam is transmitted at a specified eleva- 
tion angle, (3 . and azimuth angle 6 . It returns a range 

of the surface data point. The vehicle also measures 
the corresponding value of ^ and . 

The specific scanning pattern used is illustrated 

in Figure 2. This shows two "W" shaped scan rows separated 

by an elevation increment, 0. . and A0 are constant for 

> }nc * 

the scan. Consecutive points in each row are taken within a 
millisecond of each other, a technique referred to as rapid 
scan.* With this method, the roll and pitch angles of the 
vehicle essentially do not change for neighboring data points. 
However, because of the large number of data points in each 
row, the vehicle does change its angular position between 
corresponding points on different scan rows. 
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vehicle 



quantities 0 ( R and 0 , the two 
coordinate systems and the trans- 
f o rma tion angles (J> and ^ 



PART 3 


MODELING PROCEDURE STEP I 
A . Formation of planes 

The first step in the modeling procedure stochas- 
tically models planes from sets of four data points, using a 
previously developed procedure . ^ 

The four points used for each plane are chosen 
from the same scan row such as points (l,l),(l,2), (1,3) and 
(l,4) in Figure 2. By choosing the paints in this manner and 
utilizing the rapid scan technique, the plane can be modeled 
in the h" , a" , b"-coordina te system. This is valid since the 
four neighboring points are taken with essentially the same 
and (j) angles. This would not be true if points were taken 
from different scan rows, such as points ( 1 , 1 ) , (2,1), (1,2), 

(2,2) in Figure 2 since the points are no longer token with 
the same T| and (j) angles. 

In Figure 3, the notation for a modeled section is 
introduced which will be used in the remainder of this report. 
Here the superscript 'n‘ refers to the plane number. In the 
procedure described below, four planes are modeled for each 
section; therefore, n=l,2,3 f 4. The double primed, superscript 
refers to whether the quantity named is in the h" , a" , b" -coordi 
nate system, or if it is missing, the h , a , b-coordinate system. 

If the subscript is a number/ then the quantity 
refers to a measured data point. If the subscript is a' 'p*, 
then this quantity refers to a modeled center point which is 
* defined later. 
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The procedure is outlined below for finding the 
equation of the plane *n’. An equation of the form 

a ft n . // //n 


h " ft ft n // 

= a x, + b X 


+ * 


//n 

3 


( 1 ) 


is used to describe the plane in the n” ,a'' ,b" .-coordinate 
system, 
where 


//n d h 

X, = 


J 


//n 

x ■ = 


a a 

an 7 

ab" 


and 


//n 


is the height of the plane at a ,; = o f b“ = o, These 


it 


"X j ' s are constant parameters which must be determined. 

In order to determine the pararne ters.-f irst the 

0 * n __ ^ 

spherical coordinates of the data points, 0. , p. R» are 

1 I ) i 


converted into the h” , a H , to" -coordinates by 


. ft ^ ^ n n 

h; = 3" Rj 5tnp 


//n m n 

dj = Kj COS Pj SID 0: 
," n _ n n n 

bj = R. cos (3- cos 0. 


( 2 ) 

(3) 

(4) 


i = 1 ,2,3, 4 

A matrix equation is then written utilizing the 
location of the four data points, and a least square estima- 
tion of the parameters is formed by 

//T , //n 


x //n = (AV) V T ii 


(5) 



where 


and 



The aquation of the plane is now determined. 

The center point, P n , (Figure 3) is a point on the 
modeled plane centrally located between the four data points 


used in determining the plane. Its h ", a ", b "-coordinates can 
be found from 



B . Trans f orma t i on of center point information 

The location, height, cross-path and in-path slopes 
of the center point, P n , have been found above for the h",a",b 
coordinate system. However, this information must be trans- 
formed into the h , a v b-coordincte system to be used for the 


terrain model . 



The height and location con be transformed by 


r~ n 
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In order to find the cross-pcth and in-path slope 
of the modeled plane in the unprimed system, the normal to, the 

M r. , 4 

plane, N , is used. The equation for the plane is rewritten as 


_ "n . n //n n n n , tt //n 

O - x 4 h + x. a + b + x 3 


(10) 


where 


//n 

\ =-1 


. if . ft Jf 


If the unit vectors l j J jk are defined as in 
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Figure 3, then N' n can be written 

/m ,u 


t'n , // 


, //n // nii ,/» 

N = x 4 i + x, j + x z k 


< 11 ) 


Since the normal is a vector, the normal in the 

primed system (N ), must be the same vector as the normal 

in the unprimed system (N n ). With the unit vectors shown in 

kt n 

Figure 4 the vector N 


is written as 



Using the transformation from the primed to the 
unprimed system 

N n = C(>")B(?") 

Or rewriting with s — | 


M" “ 
,N h 

1 

— "1 
-1 

K 

= C(f)B(f) 

v »n 

A i 

-N b n _ 

-V • < ' n 

L *z j 


Using the normal N the modeled plane is written 
in the h ; a , b-coordinate system as 


O = n" h +N n a -t-N^b 4 - K n 

h a b 


where K is a constcnt. 
n 

Now using Eqn . 
the unprimed system, the 
found end labeled as: 

cross-path slope *= 

in-path slope = 


15 as the modeled plane equation in 
cross-path and in-path slopes are 


n _ d h 
i ~ 


" - h 
2 ~ db 
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Nh 

Nb. 

N h 


(16) ' 

( 17 ) 


Therefore, the location, height, cross-path and 
in-path slopes are known for the center point P n , 

Repeating this process for a total of four planes 
resuits in four center points. This situation is shown in 
Figure 4 where the location, height and derivatives are found 
at each center point. Thus, there are twelve known quantities 
which are used in the terrain modeling process for each section 


modeled . 





PART 4 


MODELING PROCEDURE STEP II 


- A. Surface equation 

To represent the terrain, a two-dimensional third 


order polynomial 
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^ C nn C J0 O + G OJ b + C 2o 2 


00 
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+ C U Q b + c 0 - + Can 6 + C 3 , 7 b +. C,QT 


(18) 


JO 6 2 


'12 2 ^ o3 (q 

larame t 

be determined in order to represent the surface. 


was chosen where the C^y 's ure unknown parameters which must 


B. Coordinate shifting 

The polynomial used for the surface equation is 
centered around the origin and it models well near the origin 
and worsens as the distance from the origin increases. There- 
fore, the polynomial should be centered as close as possible to 
the section in which it is used. This can be accomplished 
by shifting the coordinate axis. A new coordinate system Q b 
is formed by shifting the axis so that the poin t ^ bp ) is 

located at (0,0) in the Q f fc> system (Figure 4). This is 
accomplished by the transf ormation 
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equation 


A new set of parameters is used to write the surface 
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Or this can be written in matrix notation as: 
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where 
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Expressions con easily be found for and t 


from Eqn, 20. These are written in matrix notation as: 
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Since at each center point the location, height, 

dh 


j/^q » and ^/^b^ ' are * nown * 12 eqns. can be written relat- 


ing the known quantities to the unknown parameters. 
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These 12 eqns. are written in a single matrix 
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C * Matrix order reduction 
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point number one are (o^o) Thi* 

allows three parameters Kq • 

meters to be written immediately by utilise 

Eqns. 23. Thus . i * 
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1 to 

x* = C * 

Of 


( 25 ) 


By utilizing the above values for the first three 


parameters and eliminating the first 
a new matrix equation is written as 

W-TCJ.* 


throe rows of Eqn. 
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( 26 ) 


where 
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and 


Cl *=[ C* C* C* C * c* r * r ' 
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T 


(26c) 


/v /\ 

This mani pul at i on reduces W (12 x l) to W (9 x l), T (12 x 10) 
to T (9 x 7>, and C* (10 x l) to Cl* (7 x l). 


0 , Stochastic fitting 

Both W and T t in Eqn. 26 are known quantities and C»1 

is the unknown vector to be determined. Since the order of W 

♦ 

is higher than that of Q1 (9 to 7) this system of equations 
is overdetermined. Therefore, a stochastic fit must be used. 


The method of least squares estimation was chosen to perform 
the stochastic fit. This is accomplished by the matrix equation 

g*=(r T T)Vw <-> 

Eqn. 27 requires the inversion of (T T) a 7 x 7 matrix. 

Once the ci* vector is determined, the cj vector 
is also determined. Thus,, the surface polynomial, Eqn. 20, 
can be written. This allows the calculation of the modeled 
height, cross-path and in-path slopes for any location (a,b). 
With this information, the gradient at location (a,b) can be 
calculated by 


Gradient — . 




(28) 


b h/ 
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PART 5 


ERROR ANALYSIS 

A . Covorionce matrix for the data points 

Because of instrumental inaccuracies in measuring 
9 1 (3 and R .there is error involved in the de te rminat ion of 
a", b" and h “ for eaclv measured data point. This error can be 
expressed by an error covariance matrix for each data point. 1 
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n 3 l ; 2j3 y 4 


Where E denotes expected value and SR ? are assumed 

uncorrelated . This equation relates the standard deviations 
of h" n , a' ,n , b ,,n for each data point to the standard deviation 
of R ; 0 and 0 which are known quantities. There are 16 of 
these matricies. 


B . Covariance mo trix of the slopes in the 
primed system 
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Because of inaccuracies in measuring the data 
points, the modeled plane is also subject to inaccuracies. 
The erro s covariance matrix for the slopes can be expressed 
as a function of the covariances of the four data points 
which are used in modeling the plane. 1 

K" s*r sxffi 

[ = F {£[«.*■ 
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F = (A" T A") A“ 

These values can easily be evaluated and they relate 
the covariance matrix of the slopes to the standard deviation 
of the measured quantities. There are four of these matricies 
for each section modeled. 


C ‘ Covariance mat rix for the center do infs 
in the primed system " c 

Using perturbation technique, the error covariance 
matrix for the center points in the primed system can be evalu- 
ated. Since there are six variables of interest, the covariance 
matrix for the center points is a 6 x 6 matrix. Because some 
of the quantities in this matrix ere a function of other 
quantities in the same matrix, the covariance matrix may best 
be evaluated by partitions, as shown in Eqn. 31. 
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Block IV can be evaluated as shown in Appendix A- 
and yields ^ 
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The separate terms in Block V can be evaluated as 
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Where -fj. ore elements of F = (A T aJ" A T i = l / 2 ,^ 

These terms are derived a 

• ed ln A Ppend i x B and can be 

^^^culQ’tcd d i r e r t 1 \/ x 

directly from Eqn, 29. 
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This equation is derived in 

. , d ln Apqenai * C. Note that 

the expected value matrix used in Eqn 35 
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where the quantities 5 and HI are defined in Eqn. 35, 

Thus, the covariance matricies in the primed 
system can be calculated for the four center points. This 
matrix relates the standard deviations of the quantities at 
the center points to the standord deviations of R ; 0 , and ft 


D , Covariance matrix of the center points 
in the unprimed system 

In the modeling process, the center points were 
transformed into the unprimed system before the polynomial 
parameters were evaluated. Therefore, the error covariance 
matrix of the center points must also be transformed into 
the unprimed system. In this stage, the error in roll and 
pitch measurement is introduced into the model. 

The covariance matrix of the center points in the 


unprimed system is defined as: 
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Note the absence of any SiXj terms. These are 
not included since they are not used in the modeling process. 


Again breaking this matrix into blocks 







Slock A may be evaluated by using the expression 
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-The derivation for the equation is shown in 
Appendix D, Notice that this expression is a function of the 
standard deviation of pitch and roll and also of the covariance 
matrix of the center points in the primed system, £qn, 31. 

This will be the case for all of the blocks in Eqn. 38. 

For evaluating Block B, the expression 
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is found. The derivation is shown in Appendix E. Since the 
covariance matrix Eqn, 38 is symmetric. Slock C is just. the 
transpose of Block B. 

Finally, Block 0 is found by squaring Eqn. E-10 
and taking the expected value 
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Now eliminating non-correllated terms 
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Therefore, the error covariance matricies for 

the four center points in the unprimed coordinate system 

* 

be determined. 


(41 ) 
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E . Covorionce matrix of the modeling 
parameters 


The covariance matrix of the C. parameters used 
in the surface polynomial must be found. This 10 x 10 matrix 






Matrix M may be broken down 
c 3 


into blocks as 






Covariance Block M 1 may be easily determined as 


(See Appendix F ) 
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Block NTH can be evaluated by the expression 


derived in Appendix G 
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and fl .. is defined by Eqns. G-I6a, G-19, and G-lla. 
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is the covariance matrix for the center point 


found in Part III d. 


Block M^XII is the transpose of Block M^II since 


is a symmetric matrix. 


The expression for Block III is derived in Appendix H 


and is given by 
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Thus the covariance matrix of the C. . parameters 

ij 

can be determined. 

F . Standard deviation of height 

Once the covariance matrix of the parameters have 
been determined, the standard deviation of height can be 
found. This value is a function of location. From Eqn. 21 
the height of any point (a * , b* ) can be determined. Per- 
turbing Eqn. 21 yields 


Sh = Hrl sc 


(40) 


Finding the expected value of Eqn. 40 
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(49) 


However, from Eqn. 43, which defines $C* 5C* T as M 
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From the definition of standard deviation, 
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( 50 ) 
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where CT^ - standard deviation of height. 


G. Standard deviation of g radient 

The values of $ and s( aK 4b*) can be found 

by perturbing Eqns. 22a and 22b. 
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The covariance matrix of the slopes is defined as 



( 53 ) 


By using Eqn. 52, this becomes 
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However, from Eqn. 43 
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From Eqn. 28, the value for gradient, S^, is given as 
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Perturbing Eqn. 56 yields 
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Writing in matrix notation 


Where 
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Finding the expected value of gradient from Eqn. 5S 
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or finally 
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Thus, the standard deviation of any point on the 

"v 

modeled surface can be calculated. 



PART 6 


NUMERICAL RESULTS 

The modeling procedure explained in Parts 2-5 was 
simulated , using a computer program. This program simulates 
the scanning process, models the polynomial and performs the 
error analysis. These results vary with every terrain con- 
figuration and scanning parameters. Therefore, only one 
-detailed example will be presented here as an illustration of 
the developed modeling procedure. 

The example terrain surface is shown in Figure 5. 
Here the vehicle is located on level ground, traveling towards 
the center of a mound located 23 meters away from the front 
of the vehicle. The mound is a gaussian hill larger in width 
than in depth, with a maximum height of two meters. The 
equation of this hill is 

h = 2 e” 0 ‘ 08 (t>-23) 2 -Q.05a 2 

where h,a,b refer to the inertial coordinate system. 

Enough data points were taken to allow ten poly- 
nomial sections to be modeled. Only one section will be ... 

looked at in detail. The data points for ‘this section are 
shown graphically in Figure 5. Shown here, also, are ..the two 
”W" shaped scan rows. Although there is roll and'pitch of . 
the vehicle between each row, the points in a row are assumed 
to be taken so fast that the vehicle essentially does not roll 
or pitch between data points. __ 

The actual scan was carried out by using constant 


33 



Figure 5 


I 1 lus t rat i on of gaussion hill 
used for the example 





A P and A© increments. The A(3 angle between successive 
points in a scan row was .03261 rad., while the /S |Ht angle 
between corresponding points in the two scan rows was .06523 
rad. The A0 spacing between successive points in both rows 

V . 

was .016305 rod. The actual data for the 16 data points is 
shown in Table 1. Here the data point number refers to the 
row number {first column) and the number of the data point 
left to right (second column). For each measured point, 
the vehicle transmits the laser beam at a certain elevation 
and azimuth angle and receives the range measurement. It 
also measures the roll and pitch angle corresponding to that 
point . 

The first step in the modeling process is to model 

-planes in, the vehicle’s coordinate system from sets of four 

data points. Here no data point overlap was used. The 

data points which were used in each plane are listed below: 

Plane 1 - (1,1), (1,2), (1,3), (1,4) 

Plane 2 - (1,5), (1,6), (l,7), (1,3) 

Plane 3 - (2,1), (2,2), (2,3), (2,4) 

Plane 4 - (2,5), (2,6), (2,7), (2,8) 

The height, location, cross-path and in-path slopes 
of the center points were found in the h" , a" , b"-coordinate 
system. These quantities were then transformed into the -■ 
h ,a , b-coordinate system. 

The numerical results are shown in table 2, where 
HP is the height of the center point, Ap and BP are the a and 
b coordinates of the centei — point and XP1 and XP2 are the 
cross-path and in-path slopes respectively . 

The next step is forming the surface equation 



“1 


• 

v - 




**-'■» *■ 


1 *“ 

0 AT K POINT 

tLSVATIGN 

azimuth 

RANGE 

ROLL 

PITCH • 

HEIGHT 

A 

. . . B 

i. 

i 

G. 05268 

—0.05000 

22.42480 

0.0 . 

0.0 

1-51926 . 

-1.U9I7 

22.36472 

X* 

2 


-0 .C03t9 

20.69524 

o.o 

o.o 

1.23589 

-0.69473 

20.61031 

1 » 

3 


-0.01739 

22.05371 

c.o 

0.0 


-C .3820.5 

22.01860 

it 

4 

0.0852° 

-0 .30 1 C 8 

20.63574 

0*0 

o.o 

1.24222 

-O.C2221 

20.55874 

X* 


mibb 

0 . 31522 

22 .C43°5 

o.o 

0.0 

1.83923 

C.236C5 

22-01X76 

~ 



0.02152 

20.69043 

o.o 

0.0 

1.23756 

0.64076 

20 -6C389 

it 


0.052te 

0.04732 

22.38184 

0.0 

■ 0.0 

1.82155 

1.06958 

22.32423 

it 

e 

0.08529 

0 .08.4 U 

20.S7207 

o.o 

o.o 

mm 

1.23291 

2C..75439 

""" 2* 

i 

0.11791 

-0.05C00 

19.60449 

0.0 

0.0 

0.69393 

-0 .97296 

19.44305 

2 1 ' 



-0.33269 

If .Z2363 

. o.o 

o.o 


-0 .60702 

1G .00820 

2 t 

3 

0 . 11 79 1 

-0.0 1729 

19.3222? 

0 . 0 

0.0 

0.70220 

-0.33731 

19 -3°462 

2 t 

4 

0.15052 

--0 .00 108 

18.20410 

0.0 

0.0 

0.270 13 

-C- 01953 

17.99922 

2. 

5 


0.01522 


NHNmIM 

o.c 

0 .7026 6 

C. 25516 

19.39143 

■H 

■1 

0.1 5052 

0.0215? 

1 e .221 68 

C . 0 

0.0 

0.26770 

C .-56762 

16-CC572 



~ 0.11793 

0 .0478? 

1 9 . 5 c 8 6 3 

0.0 

0.0 

0.6 <4 3£ 

C. 83058 

19.44125 

2 ? 

6 

0.15052 

0.06413 

18.27627 

0.0 

C . 0 

0.25953 

1.15S04 

18 .03160 



Tobl 

e 1 Data 

points 

used for 

terrain model 


• 
































CENTER POINT NUMBER I 


HP 


i .53408 

AP 

a 

-0.55481 

BP 

*e 

21.38936 

XP1 

a 

0. 12824 
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0.39474 


CENTER 

POINT NUMBER 

HP 
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cx 

-0.48420 

BP 

sc 
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XP1 

E? 

0.02486 

XP2 


0.30909 


CENTER 

POINT NUMBER 

HP 

«7 

1.53014 

AP 

X£ 

0.84657 

BP 

S3 
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XPi 
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-0. 14778 

XP2 
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0. 37392 


CENTER 
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HP • 

C3 
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AP 
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0.73792 

BP 

ca 

18.71799 
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-0,03171 
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Table 2 Center point information 


COO 

*7 

1.534870 

CIO 

C= 

0, 128256 

C01 

= 

0.394753 

C20 

St 

0.212926 

Cll 

ss 

0.029409 

C02 

St 

-0.066491 

C30 
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0.023077 

C21 

33 

-0.056413 

C12 


-0.005039 

C03 

n 

-0.075679 


Table 3 Modeled polynomial parameters 



polynomial. Here the CT ^ parameters were computed using 
the information at the four center points. The values which 
were found are shown in Table 3, 

Since . the model parameters are determined, the 
height and gradient for any point can be found. In order to 
find the modeled surface shape, 100 test points were taken 
in an area bounded by the four center points. The location 
of these points is shown in Table 4. 

The height of the modeled surface corresponding to 
the 100 test points is shown in Table 5. Also shown is the 
ac tual height and the error of the modeled height compared to 
the actual height. The maximum error for this section was 
6,6 cm. Graphs of four different cross sections' of the hill 
are shown in Figure 6, Here the modeled surface can be 
seen to approximate the actual surface shape very well. 

Tables of the modeled gradient, actual gradient, 
and gradient error are given in Table 6, again for the 100 
test points in Table 4.. Figure 7 shows the gradient graphic- 
ally for four different cross sections of the hill. The 
modeled gradient can be seen to approximate the actual gradient 
very well, deviating from, the true gradient by only 2.4°, 
which is fairly small. However, since the maximum slope which 
the vehicle can climb is 25°, the actual surface indicates 
an impassable object while the model -indicates it passable. 
Therefore, the maximum threshold must be lowered to compensate 
for modeling error. 

For the error analysis, the standard deviation for 



Table 4 a and b coordinate location of test points 
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Table 5 Values of height modeled, height actual and 
height error for the test points 
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Table 6 Values of gradient modeled, gradient actual 
and height error for the test points 
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Figure 6 Plot of height modeled and height actual 
vs. distance for four hill cross sections 



Figure 6b Cross section at A o -0.08760 
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Figure 7 Plot of gradient modeled and gradient actual 
vs. distance for four hill cross sections 
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so 


elevation and azimuth angles were set at one arc minute, while 
the standard deviation of range was set at 5 cm. The standard 
deviation of roll ( CT^ ) and pitch ( 0' prtCH ') angles was 
set at 0 , 0.25 , 0.5 and 1.0 . The covariance matrici.es 
of the parameters, Eqn. 43, are shown in Table 7 for the 


four vo lues of (TV and <rl 

ROLL Pitch 

matrix increase with an increase in 
as expected. 


. The values of this 



The standard deviation of height ( 0" ) can now 

be found for the 100 test points in Table 4 for the four 

different values of (T (here rr « CT *= rr ) 

R R Rou. ° pitch '* 

These values are shown in Table 8. These values ere also 
plotted for four different cross sections of the hill. 

(Figure 8). In order to keep 0"^ below a value such as 20 cm 
would require a CT of "0.5° or less. 

K 

The standard deviation of gradient, 0%, is 

S G f 

likewise calculated for the 100 test points and for the four 
values of a R . These are shown in Table 9. Figure 9 shows 

plots of modeled O’ and actual or vs. distance for four 

so 

■different hill cross sections. For (T to be below a value 

such as 6° would require a 0* D of 0.5° or less. For CT 

K SG 

to be below 3° requires O' to be 0.25° or less. 

r\ 
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Toble 8 Standard deviation of height ( 0* H ) for 
four values of <r„ 
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PART 7 


CONCLUSION 

This report has developed in detail a two-step 
terrain modeling procedure, using gradient and height 
information obtained via a laser rangefinder. The formulated 
terrain model is composed of third order polynomials which 
approximate the actual terrain surface. Two steps are used 
instead of one so that the developed models are less sensi- 
tive to instrumental error. The use of gradient information 
in the modeling process results in a model that follows the 
actual gradient closer than one using height data only. 

This is important since the gradient is an important factor 
in determining whether -.the terrain is passable or impassable 
by the vehicle. Also, this method uses few data points, 
thus saving time in the scanning process. This could allow 
the vehicle to save energy as well as increase its rate of 
forward travel. 

From the simulation results, this method of terrain 
modeling seems to have the potential for usefully portraying 
the actual terrain contour and gradient, although much work 
is still needed to refine the modeling method. 

The use of two scon rows for the terrain model may 
not prove practical unless the standard deviation of the roll 
and pitch measurement is reduced to about 0,25°. If this is 
not feasible, this modeling method may still be used if the 
scanning scheme can be changed so that enough points can be 
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found rapid from one row of scan instead of the present 
two rows of scan. 

This scheme could also be used in conjunction 
with an edge detection scheme. The plan here is for the 
edge detection scheme to locate the boundary of an obstacle. 
Once the boundary has been located, the terrain modeling 
procedure would be used to determine the frontal shape of the 
obstacle. By examining the terrain model, a decision could' 
be made as to whether or not the obstacle was passable. 

Another plan would be a data point saving technique, 
where the surface is scanned, using few data points. The 
terrain modeling procedure would then be used to determine 
a rough picture of the terrain. If any questionable areas 
were present, more data points could be taken of these areas 
to obtain a detailed model, or the area avoided completely. . 
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APPENDIX A 


DERIVATION OF COVARIANCE BLOCK IV 

”n "n 

The Quantities a and b are related to the 

P P 

measured quantities of the four data points used to determine 
the plane by 

t>f\ ( "n //n ur\ nn\ r A _i\ 

a p = ( a, + + a 3 +a 4 ) 4 1 

wn / » ftr\ . t*n . nn « "0 \ /A 

bp * ( b, * bj + b 3 * b 4 ) 4 <»-*> 

Perturbing (A-l) and (A-2) yields 

■&<£ = (sar+Sar + J°r+S<C)T. <A ' 31 

/ 

5b; n -(sb; n +sbr +sb;)^ <a -" 

Rewriting this in matrix form 


ScC 


Sb 


u n 


= Q[sa“ S»r 6 a" 6«r 6b; n sC Sb - 3 " 5 


where 


Q = 


I»»'oooo 
4 T 4 4 • 


o o o o 


4 T 4 ?J 
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Then multiplying (A-5 ) by its transpose yields 



(A-6 ) 


The expected value of (A-6) can now be taken. 

Since all of the data points are measured independently, all 
of the terms on the right of Eqn. (A-6) with non-matching 
subscripts are non-cor related . Therefore, their expected 
value is zero. Finally, this yields 



E(Sa'r) 1 0 0 o E (Sa* n 8b7) o o o 

O E(sO J o 0 o E(Sa>:) o 0 

-T“ 

0 0 E(S<4 n ) Z ooo E^jX") 0 

o o o E(sO* ooo E(W 


E(8a l n 5^)o o o 

O E(&<Csb";) O o 
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The expected value quantities in (A-7) are 
calculated in Eqn. 29. Therefore, Eqn. (a-7 ) can be evalu 
ated directly. 



APPENDIX B 


DERIVATION OF EQUATIONS 33 AND 34 


written os 


The perturbed values of the slopes can be 
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Then the vector ( S h*" — S A"x" n ) can be written 
expressly by 

"sh? - 8 a," n x," n 
5h'' n -6^"x; ,n -Sb''" x"‘ 
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or in motrix form as 



Eqn. (B-l) 
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is an element of F then the 
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For the first column the terms ore now expressed 
using Eqn. (B-4) and Eqn. (A-l) 


E (6*'" &Qp n ) = 



and rewriting this using Eqn. (B-5) 



Because terms in the right-hand side of Eqn. (8-8) 


are uncorrelated if their subscripts do not match, the expected 
value of these terms is zero. Combining terms and simplify- 
ing Eqn. { B— Q ) results in 
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A similar analysis can be done for the 
Xj 6bp ) terms yielding 
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APPENDIX C 


DERIVATION OF BLOCK II 


n 

Eqn . 8 , the height of h , can be perturbed 

F 


which yields 
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Sh p = x, Sa p + $x ( a p + x 2 Sb p + hx l b P + dX 2 (c-i) 


This can be rewritten as a matrix equation 
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Therefore, Eqn. 35 can be written directly by 
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APPENDIX D 


DERIVATION OF COVARIANCE BLOCK A 


I <,)• "' 1 


The transformation of the center point in the 

V 

primed system to the unprimed system 
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Thi r s equation can be reduced to yield 
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where D n is written in Eqn. 39. 

Multiplying Eqn. (D-3) by its transpose and 
taking the expected value 




E< 


v. 


Sh 


S n 

Op 

Sbp n 


[ 


6hp n K Sb p 


r 


E< D 


8<t> 

L J 




D + 




73 




Since £(j? and are not correlated with them- 

selves or Skp ( SQp ,1 j Sb^* then Eqn. (0-4) reduces to Eqn. 39. 




APPENDIX E 


DERIVATION OF COVARIANCE BLOCK B 


From Eqns. 16 and 17, 
and X n are written 



Perturbing Eqns. (E-l) and (E-2) 


the expressions for X^ n 
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Rewriting Eqns. 


(E-3) and (E-4) as a single 


matrix equation 
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where 
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Now from Eqn. 14 


X' 


r* 

-1 


= C n B n 

*r 

. Nf . 


L*rJ 


(E-6) 


Perturbing Eqn. (E-6 ) 
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The first two right-hand terms can be written as 1 
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where 
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Substituting the values for the quantities indi- 


cated in Eqn. (E-8) and performing the operations reduces 
the first two terms in Eqn. (E-7 } to 



8<t> 

SI 



where D n is defined in Eqn. 40. 
x 

Substituting Eqns. (E-9) and (E-7) into Eqn, 
(E-5) yields the expression 
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Multiplying Eqn. (E-10) by the transpose of 
Eqn. (D-3) and taking the expected value, one obtains. the 
expression for Block B. 







The two middle terms are eliminated since they . 
are not correlated. Finally, Eqn. (E-ll) reduces to Eqn. 40 
in the text. 



APPENOIX F 


derivation of covariance block M I 

c 

From Eqn. 25 
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Perturbing Eqn. (F-I ) results in 


-sC 


'shj' 




— 

fex,' 

SC* 

0 | 

-i 


sx' 

b* - 


(F-l) 


(F-2) 


or in another form 

= R$, 

(F-3) 


where 
and 

Multiplying Eqn. (F-3) by its transpose and 
taking the expected value results in 
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(F-4) 


However , $, $; is just the covariance matrix of 
the center point number 1. Therefore, 


M C I = R Mp R t 


(F-5) 



APPENDIX G 


derivation OF COVARIANCE BLOCK MU 

c 


The system equation is given as Eqn . 26 for the 


C I parameters. Perturbing this equation yields 

5W-TSC1* + ST Cl* 


(G-l) 


Rearranging terms in Eqn. (G-l) 
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Taking the least square estimate of the per- 
turbed parameters yields 

SCI* = (t t t)V (SW-STC1*) (G-3) 

or 

sci* = z (sw-stcj*) (g-4 ) 

where 

z = (t t t)''t t 

The next step is to find an expression for the 
right-hand side of Eqn. (G-4). The first step in this 
process is to perturb the equation for W, Eqn. 26b. 

This yields 
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However , this is wri t ten in terms of the t rans- 


formed coordinates. The transformation equation was given 
before as 



(G-6) 


Now perturbing Eqn. 


( G-6 } yields 
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Substituting the results of Eqn. (G-7 ) into 


Eqn . 
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This matrix can be split into two parts. One 
part is a function of the perturbed variables for center 
, point 1. The other part is a function of the perturbed 
variables for the center points 2, 3, 4. 
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The matricies in Eqn. (G-9) can be written as 
partitioned matricies in the compact form. . 
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where 
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In order to evaluate Eqn . (G-4) ,an expression for 

$ 

ST C 1 must also be found. Multiplying the equation for. T 
(Eqn. 26b) by Cl_ and perturbing 
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- However, since and S bp” -are defined- in Eqn. 

(G-7), this matrix must be broken into two matrices, one a 
function of the perturbed variables for the center points 
2, 3, and 4, the other a function of the perturbed variables 
for center point 1. Using the matricies defined by Eqn. 48 
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Combining terms yields 
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Where 



(G-16a) 


To find the expression for Block M II, Eqn . (G-16) 

c 

must be multiplied by the transpose of Eqn. (F-3) and the 
expected value taken. This results in 
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Since the (j>^ matricies represent perturbed quanti- 
ties, then the expected value of (Jj-^is equal to the covari 
, i , * 

Qnce ma t r i x M if i»j f or equals 0 if iifcj. 
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Multiplying terms in Eqn. (G-17) yields 



Using Eqn. {G-18)_and the fact that the expected 
value of a constant is equal to itself 
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APPENDIX H 

DERIVATION OF COVARIANCE BLOCK MITT 

c 

This block is defined by the'quan ti ty 
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Since the expression for £ci* was derived 
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Multiplying out the terms yields 
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